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METHOD AND PROCESSOR FOR OBTAINIG MOMENTS AND TORQUES 

IN A BIPED WALKING SYSTEM 
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CROSS-REFERENCE TO RELATED APPLICATIONS 

This application claims priority of U.S. provisional applications No. 
60/413,024 filed on September 23, 2002 and No.60/42 1,964 filed on October 28, 
2002. 

FIELD OF THE INVENTION 



The present invention relates to a method for obtaining moments 
acting on joints of legs of biped walking system such as biped walking robots. 
15 The present invention further relates to a method for obtaining torques to be 
given to joints of legs. 



BACKGOUND OF THE INVENTION 



20 It is required to obtain ground reaction forces acting on legs of a biped 

walking system and then based on the ground reaction forces to obtain 
moments acting on joints of the legs of the biped walking system, in control of 
human assist systems and in control of movement of biped walking robots. 
Such human assist systems are intended to assist human operations against 

25 gravity including going up and down stairs, sitting and standing up, squatting, 
and moving up and down with heavy load. Based on data including the 
obtained moments, assist torques for human assist systems or a target driving 
torque for each joint of biped walking robots can be determined. 

Japanese Patent Application Unexamined Publication (KOKAI) No. 

30 2000-249570 discloses a method for obtaining ground reaction forces. In this 
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technique, ground reaction forces acting on legs are obtained as a linear 
combination of trigonometric functions having different periods of 1/ n (n=l, 
2,...) of a walking period, because waveforms representing temporal changes 
in ground reaction forces acting on legs, periodically change while a biped 
5 walking system is normally walking. In this case, as weighting factors of 
respective trigonometric functions for the combination, fixed values 
predetermined for each biped walking system or those obtained by adjusting 
the fixed values according to geographic features, are employed. 

However, in the above technique, ground reaction forces acting on legs 

10 are obtained for a step or steps of biped walking systems and therefore 
accurate ground reaction forces can hardly be obtained in such a case as 
walking manner of biped walking systems successively changes. Further, for 
higher accuracy of ground reaction forces to be obtained, weighting factors of 
trigonometric functions must be set for each biped walking system and must 

15 be adjusted according geographic features. So, it is very difficult to obtain 
accurate ground reaction forces without being affected by environment where 
biped walking systems move and by individual variation of biped walking 
systems. 

U.S. patent No. 6,152,890 discloses an apparatus and a method to 
20 measure load of working persons. However, the apparatus and method do 
not enable accurate measurement of torques acting on the joints. 

As to biped waking robots, for example, a method is known, in which 
sensors such as 6-axis force sensors are set to ankles or feet of the robots to 
obtain ground reaction forces. Further, another method is known in which 
25 biped walking systems are made to walk on a force plate on the floor to obtain 
ground reaction forces based on outputs of the force plate. 

However, in techniques using force sensors, it is necessary to attach 
force sensors to ankles and feet of a person in order to obtain ground reaction 
forces acting on the legs of the person. Such force sensors hinder the person 
30 from walking in his or her daily life. Further, in techniques using a force 
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plate, ground reaction forces can be obtained only under an environment in 
which the force plate has been installed. 

In conventional human assist systems, differential operations are used 
to obtain moments on joints of legs and the differential operations cause noises 
5 of moments on joints of legs. Additionally, horizontal components of forces 
are used to obtain moments on joints of legs. Since horizontal forces, or 
accelerations are hard to measure, measured horizontal forces cause errors in 
moments on joints of legs. Further, many acceleration terms must be 
obtained. Accordingly, huge amount of differential operations might restrict 

10 real-time processing. 

Under the situation mentioned above, there is a great need for a 
simpler joint moment estimation method by which moments acting on joints of 
legs can be obtained accurately and in real time, particularly for persons as 
biped walking systems. 

15 Additionally, there is a great need for a real-time and robust control 

method of biped walking systems by which torques such as assist torques 
applied to joints of legs in human assist systems or the like, can be obtained. 

SUMMARY OF THE INVENTION 

20 

First, the basic idea of an estimation method of ground reaction forces, 
used in joint moment estimation method for biped walking systems of the 
present invention, will be described below. 

Motions of biped walking systems, for example, motions of legs in 
25 walking, include a single-support phase in which one of the legs (2, 2) of a 
biped walking system is in contact with the ground as shown in Fig. 1 (a) and 
a double -support phase in which both of the legs (2, 2) are in contact with the 
ground as shown in Fig. 1 (b). 

In a single -support phase, the equation of (translational) motion of the 
30 center of gravity of the biped walking system in the absolute coordinate 
system fixed to the ground on which the biped walking system moves, 
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represents such a relationship as below. That is, the relationship is that a 
product of an acceleration of the center of gravity and a weight (mass) of the 
biped walking system equals the resultant of gravity (a product of the weight 
of the biped walking system and the acceleration of gravity) and the ground 
5 reaction force acting on the leg in contact with the ground. 

More specifically, if component in the X direction (the horizontal 
direction in which the biped walking system (l) moves) and that in the Z 
direction (the vertical direction) of acceleration a of the center of gravity GO of 
the biped walking system, are represented as ax and az and component in the 
10 X direction and that in the Z direction of the ground reaction force F are 
represented as Fx and Fz, as shown in Fig. 1 (a), the equation of motion of the 
center of gravity GO is represented as below. 

T (Fx, F z — M • g) =M • T (ax, az) - • • (l) 

15 

where M is a weight of the biped walking system and g is the acceleration of 
gravity. 

In both sides of Equation (l), T ( , ) represents a two-component 
vector. Hereinafter, a notation in the form of T ( , ) represents a vector. 
20 Accordingly, if the vertical component of acceleration az at the center of 

gravity GO of the biped walking system (l), is obtained, the vertical component 
of the ground reaction force can be obtained by substituting the vertical 
component of acceleration az, a value of weight M of the biped walking system 
(l) and that of the acceleration of gravity, into Equation (2) shown below. 

25 

F z =M • (a z 4- g) • • • (2) 

In this case, the weight M required to obtain an estimated value of the 
ground reaction force F can be previously obtained by measurement or the like. 
30 Further, a location of the center of gravity GO and the horizontal component of 
acceleration az can be obtained through a known technique, using outputs of 
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sensors including those detecting bending angle (rotation angle) at respective 
joints of the biped walking system, accelerometers, gyroscopic sensors and the 
like, as described in detail below. 

In a double -support phase, the equation of (translational) motion of the 
5 center of gravity of the biped walking system, represents such a relationship 
as below. That is, the relationship is that a product of an acceleration of the 
center of gravity and a weight of the biped walking system equals the 
resultant of gravity (a product of the weight of the biped walking system and 
the acceleration of gravity) and two ground reaction forces acting on the both 

10 legs. The two ground reaction forces act respectively on the both legs at 
portions in contact with the floor. More specifically, if X and Z components of 
ground reaction force Ff acting on the leg (2) in the front in the direction of 
travel are represented as Ffx and Ffz and the X and Z components of ground 
reaction force Fr acting on the leg (2) in the rear are represented as Frx and 

15 Frz, the equation of motion of the center of gravity can be represented as 
below. 

T (Ffx+Frx, Ffz+Frz-M • g) =M • T (ax, a z) 

• • • (3) 

20 

where ax, az, M and g in Equation (3) are described above. 

According to the findings of the inventors, in a double-support phase, 
ground reaction forces Ff and Fr acting on the legs (2, 2) can be considered to 
substantially act at specific portions 12f and 12r near the lowest ends of the 

25 legs (for example, ankle portions) in directions toward the center of gravity of 
the biped walking system, as shown in Fig. 1 (b). The specific portions 12f 
and 12r and the ground reaction forces Ff and Fr acting on the legs (2, 2) can 
be related as below. That is, there exists a relationship that orientations of 
line segments connecting the center of gravity GO and the specific portions 12f 

30 and 12r of the legs (2, 2) are identical with orientations of the ground reaction 
forces Ff and Fr acting on the legs (2, 2 ). 
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More specifically, if location coordinates of the center of gravity GO, 
those of the specific portion 12f of the leg in the front and those of the specific 
portion 12r of the leg in the rear are represented respectively as (Xg, Zg), (Xf, 
X£) and (Xr, Zr), the above relationship can be represented as below. 

5 

(Zf-Zg) / (Xf-Xg) =Ffc/F£x 

(Zr-Zg) / (Xr-Xg) -Frz/Frx 

... (4) 

10 If Equations (3) and (4) are combined and a term of acceleration in the 

horizontal direction is regarded as being negligible small, the following 
equation can be obtained on the vertical components of ground reaction forces. 

Ffz = M • {AZf • (-AXr • az-AXr • g)} 
15 /(AXf-AZr-AXr-AZf) 
Frz=M • {AZr*(AXf-az + AXf-g)} 

/ (AXf • AZr-AXr • AZf) 

• • • (5) 

20 where AZf=Xf-Xg, AZf=Zf-Zg, AXr=Xr-Xg and A 
Zr=Zr— Zg. 

Accordingly, if the vertical component az of acceleration of the center of 
gravity of the biped walking system (l) and locations of the specific portions 
12f and 12r of the legs (2, 2) with respect to the center of gravity of the biped 

25 walking system (l) are obtained, estimated values for the vertical components 
of the ground reaction forces Ffz and Frz of the legs can be obtained as below. 
The vertical component az of acceleration of the center of gravity of the biped 
walking system (l), locations of the specific portions 12f and 12r, a value of a 
weight M of the biped walking system (l) and a value of acceleration of gravity 

30 g, are substituted into Equation (5) to obtain estimated values of Ffz and Frz. 

In this case, the weight M required to obtain estimated values of the 
vertical components Ffz and Frz of the ground reaction forces can be 
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previously obtained by measurement or the like. Further, the horizontal 
component of acceleration az, a location of the center of gravity GO and 
locations of the specific portions 12f and 12r with respect to the center of 
gravity GO, can be obtained through a known technique, using outputs of 
5 sensors including those detecting bending angle (rotation angle) at respective 
joints of the biped walking system, accelerometers, gyroscopic sensors and the 
like, as described in detail below. 

If terms of accelerations except terms of the acceleration of gravity and 
terms of the horizontal components of forces are regarded as being negligible, 

10 the vertical components of forces and moments acting on the knee joints of the 
legs can be obtained as below. They are obtained based on the vertical 
components of the ground reaction forces obtained in such a way as mentioned 
above, points of application of the ground reaction forces obtained based on 
attitude of the legs and the like and terms of the acceleration of gravity. The 

15 vertical components of forces and moments acting on the hip joint can be 
obtained based on the vertical components of forces and moments acting on 
the knee joints of the legs and the term of the acceleration of gravity. Further, 
based on moments acting on the knee joints and the hip joint of the legs, 
torques such as assist torques to be applied to the knee joints and the hip joint 

20 of the legs in human assist systems, can be obtained. Thus, control of human 
assist systems for assisting human operations can be realized. 

Based on the above description, the present invention will be described 
below. A method for obtaining torques to be applied to joints of a leg of a 
biped walking system, according to the present invention comprises the steps 

25 of determining which leg or legs are in contact with the ground, obtaining an 
attitude of the leg and obtaining the vertical component of acceleration of the 
center of gravity of the whole body including the leg. The method further 
comprises the steps of obtaining the vertical component of a ground reaction 
force acting on the leg, based on which leg or legs are in contact with the 

30 ground, the attitude of the leg and the vertical component of acceleration of 
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the center of gravity of the whole body including the leg and obtaining a point 
of application of the ground reaction force. The method further comprises the 
step of obtaining moments acting around the joints of the leg, using the 
vertical component of the ground reaction force acting on the leg at the point of 
5 application of the ground reaction force, the vertical components of forces 
acting on the joints of the leg and a term of the acceleration of gravity and 
without using the horizontal components of the forces acting on the joints of 
the leg and a term of acceleration except the term of the acceleration of gravity. 
The method further comprises the step of obtaining the torques to be applied 
10 to the joints of the leg, based on the moments acting around the joints of the 
leg. 

Thus, in the present invention, the vertical components alone of forces 
acting on the legs are used and the horizontal components are not used. 
Accordingly, errors in measurement of forces in the horizontal direction, that 

15 is, accelerations in the horizontal direction do not cause errors in joint 
moments. Further, since the present invention does not need an acceleration 
of each portion of the leg except the acceleration of gravity, an operation speed 
is increased. Accordingly, real-time operations can be easily achieved in 
control of human assist systems for assisting human operations and the like. 

20 According to an embodiment of the present invention, in the step of 

determining which leg or legs are in contact with the ground, the 
determination is made based on a value of the vertical component of 
acceleration measured on the body. Thus, complicated processes for the 
determination are not required and therefore an operation speed is further 

25 increased. Accordingly, real-time operations can be still easily achieved in 
control of human assist systems for assisting human operations and the like. 

According to another embodiment of the present invention, in the step 
of determining which leg or legs are in contact with the ground, the 
determination is made using a sensor. Thus, operations for the 

30 determination are not required and therefore real-time operations can be still 
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easily achieved in control of human assist systems for assisting human 
operations and the like. Further, the determination is made with reliability 
based on the sensor. 

According to another embodiment of the present invention, in the step 
5 of obtaining a point of application of the ground reaction force, the point is 
obtained based on the attitude of the leg and a location of the center of gravity 
of the body. Accordingly, robust operations can be achieved with a simple 
method. 

According to another embodiment of the present invention, in the step 

10 of obtaining a point of application of the ground reaction force, the point is 
obtained further using information from a sensor. Accordingly, the point is 
obtained with reliability based on information form the sensor. 

According to another embodiment of the present invention, the vertical 
component of acceleration of the center of gravity of the whole body, is 

15 obtained based on locations of the centers of gravity of portions of the body, 
obtained based on attitudes of the leg and other portions of the body, and the 
vertical component of acceleration measured on the body. In particular, in 
going up and down stairs or going uphill or downhill, standing up or sitting 
down and bending and stretching with heavy load, the vertical component of 

20 acceleration is large enough to be measured with reliability. Accordingly, the 
vertical component of acceleration of the center of gravity of the whole body 
can be obtained with reliability. 

According to another embodiment of the present invention, in the step 
of obtaining moments acting around the joints of the leg, at first the vertical 

25 component of a force acting on and a moment acting around the knee joint of 
the shin, are obtained using the vertical component of the ground reaction 
force acting on the shin at the point of application of the ground reaction force 
and a term of the acceleration of gravity alone. Then the vertical component 
of a force acting on and a moment acting around the hip joint of the thigh, are 

30 obtained using the vertical component of a force acting on and a moment 
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acting around the knee joint of the thigh and a term of the acceleration of 
gravity alone. 

Accordingly, a moment acting around the knee joint of the shin and a 
moment acting around the hip joint of the thigh can be obtained with 
5 reliability, using the ground reaction force acting on the leg at the point of 
application of the ground reaction force and a term of the acceleration of 
gravity alone. 

A method for obtaining moments acting around joints of a leg of a 
biped walking system, according to the present invention comprises the steps 

10 of determining which leg or legs are in contact with the ground, obtaining an 
attitude of the leg and obtaining the vertical component of acceleration of the 
center of gravity of the whole body including the leg. The method further 
comprises the steps of obtaining the vertical component of a ground reaction 
force acting on the leg, based on which leg or legs are in contact with the 

15 ground, the attitude of the leg and the vertical component of acceleration of 
the center of gravity of the whole body including the leg and obtaining a point 
of application of the ground reaction force. The method further comprises the 
step of obtaining moments acting around the joints of the leg, using the 
vertical component of the ground reaction force acting on the leg at the point of 

20 application of the ground reaction force, the vertical components of forces 
acting on the joints of the leg and a term of the acceleration of gravity and 
without using the horizontal components of the forces acting on the joints of 
the leg and a term of acceleration except the term of the acceleration of 
gravity. 

25 Thus, in the present invention, the vertical components alone of forces 

acting on the legs are used and the horizontal components are not used. 
Accordingly, errors in measurement of forces in the horizontal direction, that 
is, accelerations in the horizontal direction do not cause errors in joint 
moments. Further, since the present invention does not need an acceleration 

30 of each portion of the leg, an operation speed is increased. Accordingly, 
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real-time operations can be easily achieved in obtaining moments acting 
around joints of the legs of the biped walking system. 

A processor for obtaining torques to be applied to joints of a leg of a 
biped walking system, according to the present invention, is operable in 
5 association with angular sensors on the joints and at least one accelerometer 
set on the body of the biped walking system. The processor is configured to 
perform the following steps. The steps include determining which leg or legs 
are in contact with the ground, using information from the at least one 
accelerometer and obtaining an attitude of the leg, using information from the 

10 angular sensors. The steps further include obtaining a location of the center 
of gravity of the whole body including the leg and obtaining the vertical 
component of acceleration of the center of gravity of the whole body including 
the leg, using information from the at least one accelerometer. The steps 
further include obtaining the vertical component of a ground reaction force 

15 acting on the leg, based on which leg or legs are in contact with the ground, the 
attitude of the leg, the location of the center of gravity of the whole body and 
the vertical component of acceleration of the center of gravity of the whole body. 
The steps further include obtaining a point of application of the ground 
reaction force, using the attitude of the leg and the location of the center of 

20 gravity of the whole body. The steps further include obtaining moments 
acting around the joints of the leg, using the vertical component of the ground 
reaction force acting on the leg at the point of application of the ground 
reaction force, the vertical components offerees acting on the joints of the leg 
and a term of the acceleration of gravity and without using the horizontal 

25 components of the forces acting on the joints of the leg and a term of 
acceleration except the term of the acceleration of gravity. The steps further 
include obtaining the torques to be applied to the joints of the leg, based on the 
moments acting around the joints of the leg. 

A processor for obtaining torques to be applied to joints of a leg of a 

30 biped walking system, according to the present invention, is operable in 
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association with angular sensors on the joints, at least one accelerometer set 
on the body of the biped walking system and at least one sensor set on the leg. 
The processor is configured to perform the following steps. The steps include 
determining which leg or legs are in contact with the ground, using 
5 information from the at least one sensor set on the leg and obtaining an 
attitude of the leg, using information from the angular sensors. The steps 
further include obtaining a location of the center of gravity of the whole body 
including the leg, and obtaining the vertical component of acceleration of the 
center of gravity of the whole body including the leg, using information from 

10 the at least one accelerometer. The steps further include obtaining the 
vertical component of a ground reaction force acting on the leg, based on which 
leg or legs are in contact with the ground, the attitude of the leg, the location 
of the center of gravity of the whole body and the vertical component of 
acceleration of the center of gravity of the whole body. The steps further 

15 include obtaining a point of application of the ground reaction force, using the 
attitude of the leg and the location of the center of gravity of the whole body. 
The steps further include obtaining moments acting around the joints of the 
leg, using the vertical component of the ground reaction force acting on the leg 
at the point of application of the ground reaction force, the vertical 

20 components of forces acting on the joints of the leg and a term of the 
acceleration of gravity and without using the horizontal components of the 
forces acting on the joints of the leg and a term of acceleration except the term 
of the acceleration of gravity. The steps further include obtaining the torques 
to be applied to the joints of the leg, based on the moments acting around the 

25 joints of the leg. 

Thus, in the present invention, the vertical components alone of forces 
acting on the legs are used and the horizontal components are not used. 
Accordingly, errors in measurement of forces in the horizontal direction, that 
is, accelerations in the horizontal direction do not cause errors in joint 

30 moments. Further, since the present invention does not need an acceleration 
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of each portion of the leg except the acceleration of gravity, an operation speed 
is increased. Accordingly, real-time operations can be easily achieved in 
control of human assist systems for assisting human operations and the like. 

Further, in the invention in which information from the at least one 
accelerometer is used to determine which leg or legs are in contact with the 
ground, complicated processes for the determination are not required and 
therefore an operation speed is further increased. Accordingly, real-time 
operations can be still easily achieved in control of human assist systems for 
assisting human operations and the like. 

In the invention in which information from the at least one sensor set 
on the leg is used to determine which leg or legs are in contact with the ground, 
operations for the determination are not required and therefore real-time 
operations can be still easily achieved in control of human assist systems for 
assisting human operations and the like. Further, the determination is made 
with reliability based on the sensor. 

A processor for moments acting around joints of a leg of a biped 
walking system, according to the present invention, is operable in association 
with angular sensors on the joints and at least one accelerometer set on the 
body of the biped walking system. The processor is configured to perform 
the following steps. The steps include determining which leg or legs are in 
contact with the ground, using information from the at least one accelerometer 
and obtaining an attitude of the leg, using information from the angular 
sensors. The steps further include obtaining a location of the center of 
gravity of the whole body including the leg, and obtaining the vertical 
component of acceleration of the center of gravity of the whole body including 
the leg, using information from the at least one accelerometer. The steps 
further include obtaining the vertical component of a ground reaction force 
acting on the leg, based on which leg or legs are in contact with the ground, the 
attitude of the leg, the location of the center of gravity of the whole body and 
the vertical component of acceleration of the center of gravity of the whole body. 
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The steps further include obtaining a point of application of the ground 
reaction force, using the attitude of the leg and the location of the center of 
gravity of the whole body. The steps further include obtaining the moments 
acting around the joints of the leg, using the vertical component of the ground 
5 reaction force acting on the leg at the point of application of the ground 
reaction force, the vertical components of forces acting on the joints of the leg 
and a term of the acceleration of gravity and without using the horizontal 
components of the forces acting on the joints of the leg and a term of 
acceleration except the term of the acceleration of gravity. 

10 A processor for moments acting around joints of a leg of a biped 

walking system, according to the present invention, is operable in association 
with angular sensors on the joints, at least one accelerometer set on the body 
of the biped walking system and at least one sensor set on the leg. The 
processor is configured to perform the following steps. The steps include 

15 determining which leg or legs are in contact with the ground, using 
information from the at least one sensor set on the leg and obtaining an 
attitude of the leg, using information from the angular sensors. The steps 
further include obtaining a location of the center of gravity of the whole body 
including the leg, and obtaining the vertical component of acceleration of the 

20 center of gravity of the whole body including the leg, using information from 
the at least one accelerometer. The steps further include obtaining the 
vertical component of a ground reaction force acting on the leg, based on which 
leg or legs are in contact with the ground, the attitude of the leg, the location 
of the center of gravity of the whole body and the vertical component of 

25 acceleration of the center of gravity of the whole body. The steps further 
include obtaining a point of application of the ground reaction force, using the 
attitude of the leg and the location of the center of gravity of the whole body. 
The steps further include obtaining the moments acting around the joints of 
the leg, using the vertical component of the ground reaction force acting on the 

30 leg at the point of application of the ground reaction force, the vertical 
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components of forces acting on the joints of the leg and a term of the 
acceleration of gravity and without using the horizontal components of the 
forces acting on the joints of the leg and a term of acceleration except the term 
of the acceleration of gravity. 
5 Thus, in the present invention, the vertical components alone of forces 

acting on the legs are used and the horizontal components are not used. 
Accordingly, errors in measurement of forces in the horizontal direction, that 
is, accelerations in the horizontal direction do not cause errors in joint 
moments. Further, since the present invention does not need an acceleration 

10 of each portion of the leg, an operation speed is increased. Accordingly, 
real-time operations can be easily achieved in obtaining moments acting 
around joints of the legs of the biped walking system. 

Further, in the invention in which information from the at least one 
accelerometer is used to determine which leg or legs are in contact with the 

15 ground, complicated processes for the determination are not required and 
therefore an operation speed is further increased. Accordingly, real-time 
operations can be still easily achieved in control of human assist systems for 
assisting human operations and the like. 

In the invention in which information from the at least one sensor set 

20 on the leg is used to determine which leg or legs are in contact with the ground, 
operations for the determination are not required and therefore real-time 
operations can be still easily achieved in control of human assist systems for 
assisting human operations and the like. Further, the determination is made 
with reliability based on the sensor. 

25 

DESCRIPTION OF THE DRAWINGS 

Figure 1 illustrates a basic idea of a method of estimating a ground 
reaction force, according to the present invention. Figure 2 shows in 
30 schematic form a person as a biped walking system and devices equipped with 
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the person. Figure 3 illustrates functions of a processor included in the 
devices. Figure 4 shows a rigid body linked segment model used in 
operations of the processor shown in Figure 3. Figure 5 illustrates operations 
performed by a joint moment estimating module in the processor, shown in 
5 Figure 3. Figure 6 shows a temporal change in an estimated value of moment 
acting on the hip joint while the person (l) is going up stairs, obtained 
thorough an embodiment of the present invention. Figure 7 shows a 
temporal change in an estimated value of moment acting on the knee joint 
while the person (l) is going up stairs, obtained thorough an embodiment of 

10 the present invention. Figure 8 shows a temporal change in an estimated 
value of moment acting on the hip joint while the person (l) is going down 
stairs, obtained thorough an embodiment of the present invention. Figure 9 
shows a temporal change in an estimated value of moment acting on the knee 
joint while the person (l) is going down stairs, obtained thorough an 

15 embodiment of the present invention. Figure 10 shows a temporal change in 
an estimated value of moment acting on the hip joint while the person (l) is 
sitting in a chair, obtained thorough an embodiment of the present invention. 
Figure 11 shows a temporal change in an estimated value of moment acting on 
the knee joint while the person (l) is sitting in a chair, obtained thorough an 

20 embodiment of the present invention. Figure 12 shows a temporal change in 
an estimated value of moment acting on the hip joint while the person (l) is 
rising from a chair, obtained thorough an embodiment of the present invention. 
Figure 13 shows a temporal change in an estimated value of moment acting on 
the knee joint while the person (l) is rising from a chair, obtained thorough an 

25 embodiment of the present invention. Figure 14 is a flowchart showing 
operations of an embodiment of the present invention. 

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 

30 One embodiment of the present invention will be described referring to 
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Figs 1 to 5. 

In this embodiment a method for obtaining torques to be applied to 
joints and a method for estimating join moments, are applied to a person as a 
biped walking system. 
5 As illustrated in Fig. 2, a person (l) has a pair of legs (2, 2), a torso (5) 

comprising a hip (3) and a chest (4), a head (6) and a pair of arms (7, 7). In 
the torso (5) the hip (3) is connected with each of the legs (2, 2) through each of 
a pair of hip joints (8, 8) and is supported on the both legs (2, 2). The chest (4) 
is located over the hip (3) and can be declined toward the front of the person 
10 (l). The arms (7, 7) extend from the lateral sides of the upper portion of the 
chest (4), over which the head (6) is supported. 

Each of the legs (2, 2) has a thigh (9) extending from one of the hip 
joints (8) and a shin (11) extending from the end of the thigh via a knee joint 
(10). The end of the shin (ll) is connected with a foot (13) via an ankle (ankle 
15 joint) (12). 

In this embodiment the person (l) is equipped with devices mentioned 
below in order to estimate a ground reaction force acting on each (2) of the legs 
of the person (l) and moments acting on each (10) of the knee joints and each 
(8) of the hip joints. 

20 The chest (4) of the torso (5) is equipped with a gyroscopic sensor (14) 

(hereinafter referred to as a chest gyroscopic sensor (14)), an accelerometer 
(15) (hereinafter referred to as a chest horizontal accelerometer (15)), a 
processor (16) and a battery (17). The chest gyroscopic sensor (14) generates 
an output corresponding to an angular velocity caused by inclination of the 

25 chest. The chest horizontal accelerometer (15) generates an output 
corresponding to acceleration in the horizontal direction at the chest (4). The 
processor (16) comprises a CPU, a RAM, a ROM and other components. The 
battery (17) functions as power source for the processor (16) and other devices. 
In this case, the chest gyroscopic sensor (14), the chest horizontal 

30 accelerometer (15), the processor (16) and the battery (17) are accommodated 
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in a container (18) like a shoulder bag, fixed to the chest (4) with a belt or the 
like not shown in the drawings and thus integrally fixed to the chest (4). 

In more detail, output of the chest horizontal accelerometer (15) is 
acceleration in the anteroposterior direction in the horizontal cross section of 
5 the chest (4) (orthogonal to the axis of the chest (4)). So, when the person (l) 
stands in an upright posture on the level ground, the acceleration is that in 
the horizontal direction (the direction of the x-axis of the absolute coordinate 
system shown in Fig. 2). However, when the chest (4) is inclined from the 
vertical direction (the direction of the z-axis of the absolute coordinate system 
10 shown in Fig. 2), the acceleration is that in the direction inclined by the angle 
by which the chest (4) is inclined from the vertical direction. 

Further, the hip (3) of the torso (5) is equipped with a gyroscopic sensor 

(19) (hereinafter referred to as a hip gyroscopic sensor (19)), an accelerometer 

(20) for generating an output corresponding to acceleration in the horizontal 
15 direction at the hip (3) (hereinafter referred to as a hip horizontal 

accelerometer (20)) and another accelerometer (21) for generating an output 
corresponding to acceleration in the vertical direction at the hip (3) 
(hereinafter referred to as a hip vertical accelerometer (21)). The hip 
gyroscopic sensor (19) generates an output corresponding to an angular 
20 velocity caused by inclination of the hip. The above sensors are integrally 
fixed to the hip (3) with fixing means such as a belt or the like not shown in 
the drawings. 

In more detail, as in the case of the chest horizontal accelerometer (15), 
the hip horizontal accelerometer (20) detects acceleration in the 

25 anteroposterior direction in the horizontal cross section of the hip (3) 
(orthogonal to the axis of the hip (3)). Further, in more detail, the hip vertical 
accelerometer (21) detects acceleration in the direction of the axis of the hip (3) 
(, which is orthogonal to the direction of acceleration detected by the hip 
horizontal accelerometer (20)). The hip horizontal accelerometer (20) and the 

30 hip vertical accelerometer (21) may be an integral biaxial accelerometer. 
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The hip joint (8) and knee joint (10) of each (2) of the legs are equipped 
respectively with a hip joint angular sensor (22) generating an output 
corresponding to a bending angle A 0 c and a knee joint angular sensor (23) 
generating an output corresponding to a bending angle A 0 d . Although Fig. 
5 2 shows the hip joint angular sensor (22) concerning the hip joint (8) of the leg 
(2) on the right side of the person (l), alone, the hip joint (8) of the leg (2) on 
the left side of the person (l) is equipped with another hip joint angular sensor 
(22) just as in the case of the right side. 

The angular sensors (22, 23) comprise potentiometers, for example, 

10 and are attached to each (2) of the legs by such means as a band not shown in 
the drawing. In more detail, a bending angle A Q c detected by each (22) of 
the hip joint angular sensors is a rotation angle around the hip joint (8) 
(around the lateral axis of the hip joint (8)) of the thigh (9) of each of the legs 
with respect to the hip (3). The reference angle is the rotation angle 

15 measured when the hip (3) is in proper relation with each (2) of the legs. For 
example, the reference angle is the rotation angle measured when the axis of 
the hip (3) and the axis of the thigh (9) are substantially parallel to each other 
as in the case that the person (l) is in an upright posture. Similarly, a 
bending angle A 0 d detected by each (23) of the knee joint angular sensors is 

20 a rotation angle around the knee joint (10) (around the lateral axis of the hip 
knee joint (10)) of the shin (ll) of each of the legs with respect to the thigh (9). 
The reference angle is the rotation angle measured when the thigh (9) is in 
proper relation with the shin (ll). For example, the reference angle is the 
rotation angle measured when the axis of the thigh (9) and the axis of the shin 

25 (11) are substantially parallel to each other. 

One or more foot switches (24) may be provided with portions of the 
legs, to be in contact with the ground. Foot switches (24) detect which leg or 
legs are in contact with the ground, with a contact method. 

Alternatively, range sensors with an infrared method or the like, not 

30 shown in the drawings may be attached to the ankle joints or the knee joints. 



19 



Q03038US 

In this case, distances to the floor have been previously measured in an 
upright posture. Based on the previously measured distances and distances 
measured by the sensors in walking, it is determined which leg or legs are in 
contact with the ground. 

The sensors (14, 15 and 19 to 24) and the range sensors not shown in 
the drawings, are connected with the processor (16) via signal lines not shown 
in the drawings to deliver their outputs to the processor (16). 

The processor (16) is provided with functional modules as shown in Fig. 
3. The processor (16) may be provided with a leg-motion determining module 

(25) . The leg-motion determining module (25) determines whether the legs (2, 
2) of the person (l) are in a single-support phase (as shown in Fig. 1(a)) or in a 
double-support phase (as shown in Fig. 1(b)), using data detected by the hip 
vertical accelerometer (21) and predetermined thresholds. Alternatively, foot 
switches (24) on portions to be in contact with the ground or range sensors not 
shown in the drawings, may be provided so that information from the foot 
switches (24) or the range sensors can be used to determine which leg or legs 
are in contact with the ground. Further, the processor (16) is provided with a 
chest inclining angle-measuring module (26) and a hip inclining 
angle-measuring module (27). The chest inclining angle -measuring module 

(26) measures an inclining angle 0 a of the chest (4) (more specifically, for 
example, an inclining angle 6 a from the vertical direction as shown in Fig. 
2) in the absolute coordinate system Cf, using data detected by the chest 
horizontal accelerometer (15) and chest gyroscopic sensor (14). The hip 
inclining angle -measuring module (27) measures an inclining angle 0 b of 
the hip (3) (more specifically, for example, an inclining angle 9 b from the 
vertical direction as shown in Fig. 2) in the absolute coordinate system Cf, 
using data detected by the hip horizontal accelerometer (20) and hip 
gyroscopic sensor (19). 

Further, the processor (16) is provided with a reference-acceleration 
measuring module (28). The reference acceleration measuring module (28) 
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obtains the vertical component a 0 z of (translational) acceleration of the origin 
point O in the body coordinate system Cp (xz coordinates in Fig. 2), using data 
detected by the hip horizontal accelerometer (20) and the hip vertical 
accelero meter (21) and an inclining angle 0 b of the hip (3) detected by the 
5 hip inclining angle -measuring module (27). The body coordinate system Cp 
(xz coordinates in Fig. 2) is fixed to the hip (3) as the reference point of the 
person (l) in this embodiment, as shown in Fig. 2. In more detail, the body 
coordinate system Cp has its origin point O at the middle point of the line 
segment connecting the centers of the right and left hip joints (8, 8) of the 
10 person (l), its z axis in the vertical direction and its x axis in the moving 
direction of the person (l) in the horizontal plane. The directions of the three 
axes of the body coordinate system Cp are identical with those of the absolute 
coordinate system Cf. 

The processor (16) is provided with a leg-attitude computing module 
15 (32). The module (32) obtains an inclining angle 6 c of the thigh (9) of each 
(2) of the legs and an inclining angle 8 d of the shin (ll) of each (2) of the legs 
in the absolute coordinate system Cf. More specifically, for example, the 
inclining angles are those from the vertical direction, as shown in Fig. 2. The 
module (32) obtains the inclining angles, using data detected by the hip joint 
20 angular sensor (22) and knee joint angular sensor (23) of each of the legs and 
an inclining angle 9 b of the hip (3) measure by the hip inclining 
angle-measuring module (27). 

The processor (16) is provided with a portion center of gravity location 
computing module (31). The module (31) obtains locations of the centers of 
25 gravity of portions of the person (l) corresponding to rigid segments of a 
rigid body linked segment model mentioned below (in more detail which leg 
or legs, locations of the centers of gravity of portions corresponding to rigid 
segments, in the body coordinate system Cp mentioned above). The 
module (31) obtains the locations of the centers of gravity, using an inclining 
30 angle 9 a of the chest (4) measured by the chest inclining angle-measuring 
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module (26), an inclining angle 8 b of the hip (3) measured by the hip 
inclining angle-measuring module (27) and an inclining angle 6 c of the 
thigh (9) of each (2) of the legs and an inclining angle 6 d of the shin (ll) of 
each (2) of the legs, obtained by the leg- attitude computing module (32). 
5 The portion center of gravity location computing module (31) and 

leg- attitude computing module (32) constitute a body geometric model (30). 

Further, the processor (16) is provided with a body center of gravity 
location computing module (41) and a body center of gravity- acceleration 
computing module (42). The module (41) obtains the center of gravity of the 
10 whole person (l) in the body coordinate system Cp, using locations of the 
centers of gravity of portions corresponding to rigid segments. The center of 
gravity-acceleration computing module (42) obtains vertical component az of 
acceleration of the body center of gravity GO in the body coordinate system Cp 
(shown in Fig. l). 

15 The body center of gravity location computing module (41) and center 

of gravity-acceleration computing module (42) constitute a body mass 
distribution model (40). 

The processor (16) is provided with a module (50) for estimating a 
point of application of ground reaction force. The module (50) locates a point 

20 of application of ground reaction force acting on a leg in contact with the 
ground. The module (50) locates the point, using an inclining angle 9 c of 
the thigh (9) and an inclining angle 0 d of the shin (ll) obtained by the 
leg- attitude computing module (32) and the center of gravity of the whole 
obtained by the body center of gravity location computing module (41). 

25 Alternatively, information from foot switches (24) or range sensors not shown 
in the drawings can be used to estimate a point of application of ground 
reaction force, as mentioned in more detail below. 

The processor (16) is provided with a ground re action -force estimating 
module (60) for obtaining a ground reaction force acting on each (2) of the legs. 

30 The ground reaction-force estimating module (60) obtains a location of the 
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ankle (12) of each (2) of the legs, as a specific part of each (2) of the legs, with 
respect to the center of gravity of the whole body GO (hereinafter referred to as 
body center of gravity GO). In more detail, the location is represented by (A X 
f, AZf)or(AXr, AZr) in Equation (5). The module (60) obtains the 
5 location, using a location of the body center of gravity GO, obtained by the body 
center of gravity location computing module (41) and inclining angles 0 c of 
the thigh (9) and 6 d of the shin (ll) of each (2) of the legs, obtained by the 
leg-attitude computing module (32). Further, the module (60) obtains an 
estimated value of the vertical component of the ground reaction force acting 

10 on each (2) of the legs, using the location, the vertical component az of 
acceleration of the body center of gravity and state of which leg or legs are in 
contact with the ground, determined by the leg-motion determining module 
(25). The vertical component az is obtained by the center of 
gravity-acceleration computing module (42). 

15 The processor (16) is provided with a joint moment estimating module 

(71) for estimating moments acting on the knee joint (10) and the hip joint (8) 
of each of the legs. The module (71) estimates moments, using a value 
estimated by the ground reaction-force estimating module (60), a location 
estimated by the module (50) for estimating a point of application of ground 

20 reaction force and inclining angles 6 c and 6 d of the thigh (9) and the shin 
(ll) of each (2) of the legs, obtained by the leg-attitude computing module (32). 

The processor (16) is provided with a gravity compensation 
torque -computing module (72) for obtaining assist torque for assisting the 
person, that is, gravity compensation torques by multiplying estimated values 

25 of moments obtained by the joint moment estimating module (71), by certain 
factors. 

The joint moment estimating module (71) and gravity compensation 
torque-computing module (72) constitute a gravity compensation model (70). 
Operations of this embodiment carried out by the modules of the 
30 processor (16) will be described in detail below. 
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In this embodiment the processor (16) starts to carry out the following 
successive operations periodically to obtain an estimated value of the ground 
reaction force acting on each (2) of the legs or the like, when the person (l) 
with his or her legs (2, 2) being in contact with the ground, turns on the power 
5 switch of the processor (16) not shown in the drawings, before he or she starts 
moving his or her legs, for example walking. 

First, the processor (16) has the leg-motion determining module (25) 
carry out processes. In the processes of the leg-motion determining module 
(25), an acceleration value at the hip (3) in the upward and vertical direction, 

10 detected by the hip vertical accelerometer (21), is compared with a * 
predetermined threshold periodically. When the detected acceleration value 
exceeds the threshold, it is determined that the motion is in a single-support 
phase in which the front leg is in contact with the ground as shown in Fig. 1(a). 
When the detected acceleration value is less than or equal to the threshold, it 

15 is determined that the motion is in a double -support phase as shown in Fig. 

Kb). 

Alternatively, outputs of the foot switches (24) provided on portions of 
the legs to be in contact with the ground or the range sensors not shown in the 
drawings, are read periodically to determine which leg or legs are in contact 

20 with the ground. 

Concurrently with the above-mentioned processes of the foot switches 
(24) or the range sensors, or of the leg-motion determining module (25), the 
processor (16) carries out processes of the chest inclining angle -measuring 
module (26) and hip inclining angle-measuring module (27). In the processes 

25 of the chest inclining angle -measuring module (26), an inclining angle 6 a of 
the chest (4) in the absolute coordinate system Cf is successively obtained by 
processing data of acceleration in the horizontal direction detected by the 
chest horizontal accelerometer (15) and data of angular velocity detected by 
the chest gyroscopic sensor (14), with a known method using Karman filter. 

30 Similarly, in the processes of the hip inclining angle -measuring module (27), 
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an inclining angle 8 b of the hip (3) in the absolute coordinate system Cf is 
successively obtained by processing data of acceleration in the horizontal 
direction detected by the hip horizontal accelerometer (20) and data of angular 
velocity detected by the hip gyroscopic sensor (19), with a known method using 
5 Karman filter. In this embodiment, for example, an inclining angle 6 a of 
the chest (4) and an inclining angle 9 b of the hip (3) in the absolute 
coordinate system Cf, are those from the vertical direction (the direction of 
gravity). 

An inclining angle of the chest (4) and an inclining angle of the hip (3) 
10 can also be obtained by integrating data of angular velocities detected by 
gyroscopic sensors (14) and (19), for example. However, the method using 
Karman filter in this embodiment enables more accurate measurements of an 
inclining angle 0 a of the chest (4) and an inclining angle 6 b of the hip (3). 

Next the processor (16) carries out processes of the leg-attitude 
15 computing module (32) and reference-acceleration measuring module (28). 

In the processes of the leg-attitude computing module (32), an 
inclining angle 0 c of the thigh (9) of each (2) of the legs and an inclining 
angle 9 d of the shin (ll) of each (2) of the legs in the absolute coordinate 
system Cf, are periodically obtained as below. Inclining angles are those from 
20 the vertical direction as shown in Fig. 2. An inclining angle 0 c of the thigh 
(9) of each (2) of the legs, is obtained by substituting a current value of bending 
angle A 6 c of the hip joint (8) detected by the hip joint angular sensor (22) 
and a current value of inclining angle 0 b of the hip (3), obtained by the hip 
inclining angle-measuring module (27), into the following equation. 

25 

9c = eb + A8c •••(6) 

A value of inclining angle 0 b of the hip (3) becomes negative when 
the hip (3) is inclined from the vertical direction in such away as the top end of 
30 the hip (3) is located forward than the bottom end, toward the front of the 
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person (l). A value of bending angle A 0 c becomes positive when the thigh 
(9) is inclined in such away as the bottom end of the thigh (9) is located toward 
the front of the person (l). 

An inclining angle 9 d of the shin (11) of each (2) of the legs is 
5 obtained by substituting a current value of inclining angle 0 c of the thigh 
(9) previously obtained as mentioned above and a current value of bending 
angle A 0 d detected by knee joint angular sensor (23) attached to the leg, 
into the following equation. 

10 0d=0c-A0d * • • ( 7 ) 

A value of bending angle at the knee joint (10) becomes positive when 
the shin (ll) is inclined from the axis of the thigh (9) toward the back. 

In the processes of the reference -acceleration measuring module (28), 

15 the vertical component a 0 z of acceleration of the origin point O in the body 
coordinate system Cp is obtained as below. A current value of acceleration in 
the vertical direction (the direction of the axis of the hip) at the hip (3) 
detected by the hip vertical accelerometer (21) is represented as aq. Then, a 
value of the vertical component a 0 z of acceleration in the body coordinate 

20 system Cp is obtained by substituting the value aq and a current value of 
inclining angle 0 b of the hip (3) obtained by the hip inclining 
angle -measuring module (27), into the following Equation (8). 

a 0 z =aq • cos 0 b — g • • • ( 8 ) 

25 

Next the processor (16) carries out processes of the portion center of 
gravity location computing module (31) to obtain locations of the centers of 
gravity in the body coordinate system Cp, of portions of the person (l) 
corresponding to rigid segments, using a rigid body linked segment model 
30 mentioned below. 
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As shown in Fig. 4, a rigid body linked segment model R used in this 
embodiment represents the person (l) as a combination of rigid bodies (Rl, Rl) 
corresponding to the thighs (9, 9) of the legs, rigid bodies (R2, R2) 
corresponding to the shins (11, 11) of the legs, a rigid body R3 corresponding to 
5 the hip(3) and a rigid body R4 corresponding to a portion (38) comprising the 
chest (4), the arms (7, 7) and the head (6). The portion is hereinafter referred 
to as the upper part (38). A coupler between Rl and R3 and that between Rl 
and R2 correspond respectively to one (8) of the hip joints and one (10) of the 
knee joints. By a portion corresponding to a coupler between R3 and R4, the 

10 hip (3) supports the chest (4) inclinably. 

In this embodiment locations of the centers of gravity Gl, G2, G3 and 
G4 of the portions (the thighs (9, 9) and the shins (11, 11) of the legs, the hip 
(3) and the upper part (38)) corresponding to rigid segments Rl to R4 in the 
rigid body linked segment model R, are previously obtained and stored in a 

15 memory connected to the processor (16), not shown in the drawings. 

Locations of the centers of gravity Gl, G2, G3 and G4 of the portions, 
stored in the processor (16), are those in a coordinate system fixed to each of 
the portions. In this case, a distance from the center of the joint at an end of 
a portion measured in the axial direction, is used to represent each of the 

20 locations of the centers of gravity Gl, G2, G3 and G4 of the portions. For 
example, as shown in Fig. 4, a location of the center of gravity of one (9) of the 
thigh is represented by a distance tl from the center of the hip joint (8) of the 
thigh (9) in the axial direction of the thigh (9). A location of the center of 
gravity of one (11) of the shin is represented by a distance t2 from the center of 

25 the knee joint (10) of the shin (ll) in the axial direction of the shin (11). 
Values of distance tl and distance t2 are previously stored in the processor 
(16). Locations of the centers of gravity G3 and G4 of the other portions are 
represented similarly. 

Strictly speaking, motions of the arms (7, 7) affect a location of the 

30 center of gravity G4 of the upper part (38). However, in walking locations of 
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the arms (7, 7) are generally symmetric with respect to the axis of the chest (4) 
and therefore a location of the center of gravity G4 of the upper part (38) does 
not change significantly remaining substantially identical with that in an 
upright posture, for example. 
5 Further, in this embodiment, other data of the portions (the thighs (9, 

9) and the shins (11, 11) of the legs, the hip (3) and the upper part (38)), 
including weights and sizes (for example, lengths) besides locations of the 
centers of gravity Gl, G2, G3 and G4, are previously obtained and stored in 
the processor (16). 

10 A weight of one (ll) of the shins includes that of corresponding one (13) 

of the feet. Data stored previously in the processor (16) may be obtained 
through actual measurements, or may be estimated through a height and a 
weight of the person (l) based on average values obtained from statistical data 
of persons. Generally, locations of the centers of gravity Gl, G2, G3 and G4, 

15 weights and sizes of the portions show a correlation with heights and weights 
of persons. Accordingly, locations of the centers of gravity Gl, G2, G3 and G4, 
weights and sizes of the portions can be estimated based on data of a height 
and a weight of a person with a relatively high accuracy. 

The portion center of gravity location computing module (31) obtains 

20 locations of the centers of gravity Gl, G2, G3 and G4 of the portions 
corresponding to rigid segments in the body coordinate system Cp (xz 
coordinates in Fig. 2) fixed to the hip (3) and having the origin point O, from 
the following data. The data include those previously stored in the processor 
(16) as mentioned above, current values of an inclining angle 0 a of the chest 

25 (4) and an inclining angle 0 b of the hip (3) and current values of an inclining 
angle 0 c of the thigh (9) of each (2) of the legs and an inclining angle 9 d of 
the shin (11) of each (2) of the legs. An inclining angle 9 a of the chest (4) 
(an inclining angle of the upper part (38)) and an inclining angle 9 b of the 
hip (3) are obtained respectively by the chest inclining angle -measuring 

30 module (26) and hip inclining angle-measuring module (27). An inclining 
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angle 6 c of the thigh (9) and an inclining angle 9 d of the shin (11) are 
obtained by the leg-attitude computing module (32). 

Since inclining angles 0 a to 0 d of each of the portions 
corresponding to rigid segments (the thigh (9) and the shin (ll) of each (2) of 
5 the legs, the hip (3), and the upper part (38)) are obtained as mentioned above, 
locations and attitudes of the portions corresponding to rigid segments can be 
determined in the body coordinate system Cp. Accordingly, locations of the 
centers of gravity Gl, G2, G3 and G4 of the portions corresponding to rigid 
segments can be obtained. 

10 More specifically, for example, in Fig. 4 an inclining angle (from the z 

axis direction) of the thigh (9) of the leg (2) on the left side is 0c. In Fig. 4, 
0 c is less than zero. Accordingly, coordinates of the location of the center of 
gravity Gl of the thigh (9) in the body coordinate system Cp are (tl • sin 0 c , 
— tl • cos 0 c ) . Further, an inclining angle of the shin (ll) of the leg (2) on the 

15 left side is 0 d . In Fig. 4, 0 d is less than zero. Accordingly, provided that 
a length of the thigh (9) is Lc, coordinates of the location of the center of 
gravity G2 of the shin (ll) in the body coordinate system Cp are ( L c • sin 0 c 
+t2 • sin 0 d , — L c • cos 9 c — 12 • cos 9 d ) . Locations of the centers of gravity of 
the thigh (9) and the shin (ll) of the other leg (2), the hip (3) and the upper 

20 part (38) can be obtained in a similar way as mentioned above. 

After the portion center of gravity location computing module (31) has 
obtained locations of the centers of gravity Gl, G2, G3 and G4 of the portions 
corresponding to rigid segments in the body coordinate system Cp, the 
processor (16) carries out operations of the body center of gravity location 

25 computing module (41). The body center of gravity location computing 
module (41) obtains a location (xg, zg) of the body center of gravity GO of the 
person (l), using location data of Gl, G2, G3 and G4 and weight data of the 
portions corresponding to rigid segments. 

In the body coordinate system Cp, a location of the center of gravity G3 

30 and a weight of the hip (3) are represented respectively by (x3, z3) and m3. A 
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location of the center of gravity G4 and a weight of the upper part (38) are 
represented respectively by (x4, z4) and m4. A location of the center of 
gravity Gl and a weight of the thigh (9) of the leg (2) on the left side of the 
person (l) are represented respectively by (xlL, zlL) and mlL. A location of 
5 the center of gravity G2 and a weight of the shin (ll) of the leg (2) on the left 
side of the person (l) are represented respectively by (x2L, z2L) and m2L. A 
location of the center of gravity Gl and a weight of the thigh (9) of the leg (2) 
on the right side of the person (l) are represented respectively by (xlR, zlR) 
and mlR. A location of the center of gravity G2 and a weight of the shin (ll) 
10 of the leg (2) on the right side of the person (l) are represented respectively by 
(x2 R, z2 R) and m2R. A weight of the person (l) is represented by M (=mlL+ 
m2L+ mlR+ m2R+m3+m4). Then, a location of the body center of gravity GO 
of the person (l) is obtained by the following equation (9). 

15 xg= (mlL • x lL+mlR • x lR+2mL • x2L+m2R • x2R 
+m3 • x3+m4 • x4) /M 
z g= (mlL • z lL+mlR • z lR-Hn2L • z 2L+m2R • z 2R 
-hm3 • z 3+m4 • z 4) /M 

• • • (9) 

20 

After the processor (16) has carried out operations of the body center of 
gravity location computing module (41), it carries out operations of the body 
center of gravity-acceleration computing module (42). 

In the operations of the body center of gravity- acceleration computing 

25 module (42), a value obtained by twice differentiating a location zg of the body 
center of gravity GO in the body coordinate system Cp, that is, the vertical 
component d 2 zg/dt 2 of an acceleration of the body center of gravity GO with 
respect to the original point O of the body coordinate system Cp, is obtained 
using the following data. The data are time-series data of a location zg in the 

30 vertical direction of the body center of gravity GO in the body coordinate 
system Cp, obtained periodically by the body center of gravity location 
computing module (41). The vertical component of acceleration az of the body 
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center of gravity GO in the absolute coordinate system Cf , is obtained by 
obtaining a sum of the value of acceleration d 2 zg/dt 2 and the vertical 
component a 0 z of acceleration of the original point O of the body coordinate 
system Cp, in the absolute coordinate system Cf. The vertical component a 0 
5 zof acceleration has been obtained by the reference -acceleration measuring 
module (28). 

Then the processor (16) carries out operations of the ground 
reaction-force estimating module (60) as below. A location of the ankle (12) of 
each (2) of the legs in the body coordinate system Cp is obtained by operations 

10 similar to those of the body center of gravity location computing module (41), 
using the following data. The data include current values of an inclining 
angle 0 c of the thigh (9) of each (2) of the legs and an inclining angle 0 d of 
the shin (ll) of each (2) of the legs, a current value of an inclining angle 6 b 
of the hip (3) obtained by the hip inclining angle-measuring module (27) and 

15 data of sizes (lengths) of the thigh (9) and shin (ll). More specifically, in Fig. 
4, provided that a length of the shin (ll) (a length from the center of the knee 
joint (10) to the ankle (12)) of the leg on the left side of the drawing is Ld, 
coordinates (xl2, zl2) of a location of the ankle (12) in the body 
coordinate system Cp are ( L c • sin 9 c + L d • sin 9 d , — L c • cos 0 c — L d • 

20 cos 0 d) . In Fig. 4, 9 c and 9 d are less than zero. Data on the other leg 
can be obtained similarly. 

Then a location vector T ( x 1 2 — x g , z 12-zg) of the ankle (12) of 
each of the legs (2), that is, A X f , A Z f , AXr and AZr in Equation (5) can 
be obtained, using current values of coordinates ( x 1 2 , z 1 2 ) of a location 

25 of the ankle (12) and coordinates (xg, zg) of a location of the body center of 
gravity GO in the body coordinate system C. 

When it is determined during a current period through the leg-motion 
determining module (25), foot switches (24) or range sensors not shown in the 
drawings that motion of the legs are in a single -support phase, an estimated 

30 value of the vertical component Fz of the ground reaction force acting on the 
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leg (2) in contact with the ground, is obtained as below. The estimated value 
is obtained by substituting the following data into Equation (2). The data 
include values of a weight M of the person (1) and the acceleration of gravity g 
(previously stored in the processor (16) ) and a current value of the vertical 
5 component az of acceleration of the body center of gravity GO in the absolute 
coordinate system Cf, obtained by the body center of gravity-acceleration 
computing module (42). 

In the above case, the vertical component Fz of the ground reaction 
force acting on the leg (2) not in contact with the ground (the leg without 

10 load) , is zero. 

When it is determined during a current period through the leg-motion 
determining module (25), foot switches (24) or range sensors not shown in the 
drawings that motion of the legs are in a double-support phase, an estimated 
values of the vertical components Ffz and Frz of the ground reaction forces 

15 acting on each (2) of the legs, are obtained as below. The estimated values 
are obtained by substituting the following data into Equation (5). The data 
include values of a weight M of the person (l) and the acceleration of gravity g, 
a current value of the vertical component az of acceleration of the body center 
of gravity GO in the absolute coordinate system Cf, obtained by the body center 

20 of gravity-acceleration computing module (42) and current values of a location 
of the ankle (12) of the each (2) of the legs with respect to the body center of 
gravity GO. The current values of a location of the ankle (12) are represented 
by AXf, AZf, AX rand AZr in Equation (5). 

The processor (16) carries out operations of the module (50) for 

25 estimating a point of application of ground reaction force concurrently with 
the above operations of the body center of gravity location computing module 
(41), the body center of gravity-acceleration computing module (42) and the 
ground reaction-force estimating module (60). 

In operations of the module (50) for estimating a point of application of 

30 ground reaction force, a vector from the ankle (12) of each (2) of the legs to the 
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point of application of the ground reaction force on the foot (13) of the leg, is 
obtained in the procedure below. The point of application of the ground 
reaction force is the point on which the whole ground reaction force acting on 
the portion of the foot (13), in contact with the ground, can be considered to be 
concentrated. The above vector is a location vector of the point of application 
of the ground reaction force, with respect to the ankle (12) and is hereinafter 
referred to as a vector of a point of application of the ground reaction force. 

As shown in Fig. 2, the ankle joint at the ankle 12 is represented as 
12A while the joint at the front end of the foot (13) (the so-called MP joint) is 
represented as 12B. First, the horizontal component xl2 of coordinates of a 
location of the ankle joint (12A) is obtained. More specifically, in Fig. 4, 
provided that a length of the shin (11) (a length from the center of the knee 
joint (10) to the ankle (12)) of the leg on the left side of the drawing is Ld, 
coordinates ( x 1 2 , z 1 2 ) of location of the ankle (12) in the body coordinate 
system Cp are ( L c • sin 8 c + Ld *sin9 d, — L c • cos 9 c — L d • cos 6 d ) . In 
Fig. 4, 0 c and 6 d are less than zero. Data on the other leg can be 
obtained similarly. Further, provided that a horizontal distance between the 
ankle joint (12A) and the MP joint (12B) is a constant D, the horizontal 
component xl2B of coordinates of a location of the MP joint (12B) is obtained 
through the following equation. 

X12B = xl2 + D 

Then walking mode is determined. If the vertical component of a 
difference between a location of the left ankle joint and that of the right ankle 
joint, as obtained in such a way as mentioned above, exceeds a certain 
threshold while the both legs are in contact with the ground, it is determined 
that the person (l) is going up or down stairs or going uphill or downhill. 
Otherwise, it is determined that the person (l) is walking under normal 
conditions. 
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Then when the person (l) is walking under normal conditions, the 
horizontal component of the endpoint of the vector of a point of application of 
the ground reaction force, is obtained by comparing the horizontal components 
obtained as mentioned above, in the following procedure. If the horizontal 
5 component xg of GO is less than the horizontal component xl2 of the ankle 
joint 12A, the horizontal component of the endpoint of the vector of a point of 
application of the ground reaction force is assumed to be the horizontal 
component xl2 of the ankle joint 12A. If the horizontal component xg of GO is 
between horizontal component xl2 of the ankle joint 12A and the horizontal 

10 component xl2B of the MP joint 12B, the horizontal component of the 
endpoint of the vector of a point of application of the ground reaction force is 
assumed to be the horizontal component xg of GO. If the horizontal 
component xg of GO is greater than the horizontal component xl2B of the MP 
joint 12B, the horizontal component of the endpoint of the vector of a point of 

15 application of the ground reaction force is assumed to be the horizontal 
component xl2B of the MP joint 12B. 

When the person (l) is going up or down stairs or going uphill or 
downhill, the horizontal component of the endpoint of the vector of a point of 
application of the ground reaction force is always assumed to be the horizontal 

20 component xl2B of the MP joint (12B). 

The vertical component of the vector of a point of application of the 
ground reaction force, is obtained with the assumption that a distance 
between the ankle joint 12A and the ground is a constant E. 

In the above procedure, the vector of a point of application of the 

25 ground reaction force, can be obtained. The vector is starting at the ankle 
joint 12A and ending at the point of application of the ground reaction force. 

Alternatively the module (50) for estimating a point of application of 
ground reaction force, can obtain the vector of a point of application of the 
ground reaction force, using information from the foot switches (24) or range 

30 sensors in the following procedure. In this case, the contact-type foot 
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switches (24) or the range sensors for the ankle joints (12A) and the MP joints 
(12B) are used to determine whether or not each of the heels and each of 
tiptoes are in contact with the ground. If both foot switches (24) or both 
range sensors for the ankle joint (12A) and the MP joint (12B) indicate that 
the portions are in contact with the ground, the horizontal component of the 
vector of a point of application of the ground reaction force, is obtained in a 
similar procedure to that in the above case where the person (l) is walking 
under normal conditions. If the foot switch (24) or range sensor for the ankle 
joint (12A), alone indicates that the portion is in contact with the ground, the 
horizontal component of the endpoint of the vector of a point of application of 
the ground reaction force is assumed to be the horizontal component xl2 of the 
location coordinates of the ankle joint (12A). If the foot switch (24) or range 
sensor for the MP joint (12B), alone indicates that the portion is in contact 
with the ground, the horizontal component of the endpoint of the vector of a 
point of application of the ground reaction force is assumed to be the 
horizontal component xl2B of the location coordinates of the MP joint (12B). 

The vertical component of the vector of a point of application of the 
ground reaction force, is obtained with the assumption that a distance 
between the ankle joint (12A) and the ground is a constant E. 

In the above procedure, the vector of a point of application of the 
ground reaction force, can be obtained, using information from the foot 
switches (24) or range sensors. The vector is starting at the ankle joint 12A 
and ending at the point of application of the ground reaction force. 

After having estimated the location of a point of application of the 
ground reaction force, the processor (16) caries out operations of the joint 
moment estimating module (71) to obtain moments acting on the knee joint 
(10) and the hip joint (8) of each (2) of the legs. The operations are carried out 
based on the so-called inverse dynamics model, using current values of data 
obtained by the ground reaction-force estimating module (60), module (50) for 
estimating a point of application of ground reaction force and leg-attitude 
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computing module (32). The inverse dynamics model uses equations of 
translational motion and rotational motion for each portion of the person (l)> 
corresponding to rigid segment, to obtain moments acting on the joints of each 
of the legs, one after another, from moment acting on the joint next to the 
5 point of application of ground reaction force. In this embodiment, moment 
acting on the knee joint (10) of each of the legs, is obtained and then that 
acting on the hip joint (8) is obtained. 

In more detail, referring to Fig. 5, a force acting on the ankle (12) at an 
end of the shin (ll) of each (2) of the legs (a joint reaction force), a force acting 

10 on the knee joint (10) of the shin (ll) (a joint reaction force) and an 
translational acceleration of the center of gravity G2 of the shin (ll) are 
represented by components in the absolute coordinate system Cf as below. 
The representations are T (F !x, F x z), T (F2x, F2z)and T (a2x, a2z). A weight of 
the shin (ll) is represented as m 2 . If acceleration terms except the term of 

15 the acceleration of gravity are neglected, the equation of translational motion 
of the center of gravity G2 of the shin (ll) is as below. 

T (O, 0) = T (Fjx-Fax, F lZ -F 2 z-m 2 - g) 

20 Accordingly, as to the vertical components, the equation of motion is as 

below. 

F 2 z=F 1 z— m 2 • g •••(10) 

25 An approximate value of the vertical component F x z of the joint 

reaction force acting on the ankle (12) at an end of the shin (ll) is equal to an 
estimated value of the vertical component of the ground reaction force 
obtained by the ground reaction-force estimating module (60) for the shin (ll) 
of the leg (2). In more detail, in a single -support phase the vertical 

30 component F^ of the joint reaction force is the vertical component Fz of the 
ground reaction force obtained through Equation (2) when the leg is in contact 
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with the ground. The vertical component Fjz is zero when the leg is idle. 
Further; in a double-support phase the vertical component F x z of the joint reaction 
force is the vertical component Frz of the ground reaction force in Equation (5) 
when the leg is the rear one of the person (l) in the traveling direction. The 
5 vertical component F a z of the joint reaction force is the vertical component Ffz 
of the ground reaction force in Equation (5) when the leg is the front one of the 
person (l) in the traveling direction. 

Accordingly, the vertical component F2Z of the joint reaction force 
acting on the knee joint (10) of each of the legs, can be obtained by substituting 
10 data of the vertical component F x z of the ground reaction force obtained by the 
ground re action -force estimating module (60), data of a weight m 2 of the shin 
(ll), previously obtained and a value of the acceleration of gravity g, into 
Equation (10). 

Referring to Fig. 5, a moment acting on the ankle (12) at an end of the 
15 shin (ll) of each (2) of the legs, a moment acting on the hip joint (10) of the 
shin (ll), a moment of inertia around the center of gravity G2 of the shin (ll) 
and an angular acceleration around the center of gravity G2 of the shin (ll), 
are represented as M 1; M 2 , I G2 and a 2 . Referring to Fig. 4, a distance 
between the center of gravity G2 of the shin (11) and the knee joint (10) and a 
20 distance between the center of gravity G2 of the shin (ll) and the ankle (12) 
are represented respectively as t 2 and t 2 ' (= Ld— t 2 ) . If horizontal force 
terms and angular acceleration terms are removed, the equation of rotational 
motion around the center of gravity G2 of the shin (ll) is as below. 

25 I G2 * a 2 — 0 =Mj — M 2 ~ F {l • t 2 ' *sin0 d — F 2 z* t 2 -sin0 d 

The equation can be rewritten as below. 

M 2 =M 1 — F^* t 2 ' -sinfld — F 2 z ♦ t 2 -sin0d 
30 •••(11) 
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Mi in Equation (ll) is a moment obtained as an outer (vector) product 
of a vector of a point of application of ground reaction force, obtained by the 
module (50) for estimating a point of application of ground reaction force and a 
vector of ground reaction force, obtained by the ground reaction-force 
5 estimating module (60). Further, since angular acceleration terms are 
removed, a 2 is assumed to be zero, d d is an inclining angle of the shin (ll), 
obtained by the leg-attitude computing module (32). F x z is an estimated 
value of the vertical component of a ground reaction force, obtained by the 
ground reaction-force estimating module (60), as mentioned above. F 2 z is 

10 obtained through Equation (10). 

Accordingly, moment M 2 acting on the knee joint (10) is obtained by 
substituting the following data into Equation (ll). The data includes an 
estimated value of the vertical component of a ground reaction force, obtained 
by the ground re action -force estimating module (60) and a vector of a point of 

15 application of ground reaction force, obtained by the module (50) for 
estimating a point of application of ground reaction force an inclining angle of 
the shin (ll). The data further includes an inclining angle 6 d of the shin 
(ll), obtained by the leg-attitude computing module (32), the vertical 
component F 2 z of a joint reaction force, obtained through Equation (10), a size 

20 (d) of the shin(ll) and a location ( t 2 ) of the center of gravity G2. 

The joint moment estimating module (71) obtains moment M 2 acting 
on the knee joint (10) of the shin (ll) as mentioned above. Then the module 
obtains a moment acting on the hip joint (8) of the thigh (9) in a way similar to 
that mentioned above. The basic idea of the operation is identical with that 

25 for obtaining moment M 2 acting on the knee joint (10) and therefore detailed 
explanation with a drawing is not given. The outline of the operation is as 
below. 

First, the vertical component Fgz of the joint reaction force acting on 
the knee joint (8) of the thigh (9) is obtained through Equation (12) (which has 
30 the form identical with that of Equation (10)) on translational motion of the 
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center of gravity Gl (Fig. 4) of the thigh (9). 
F 3 z=F 2 z-m 1 • g •••(12) 

5 F 2 z is the vertical component of the joint reaction force on the knee 

joint (10), previously obtained through Equation (10). nij is a weight of the 
thigh (9) previously obtained and g is the acceleration of gravity. 

Then, moment M 3 acting on the hip joint (8) of the thigh (9) is obtained 
through Equation (13) (which has the form identical with that of Equation 
10 (11)) on rotational motion of the center of gravity Gl of the thigh (9). 

M 3 =M 2 — F 2 z • ti • sin0 c— F 3 z • 1 1 • sin0 c 

• • • (1 3) 

15 M 2 is a moment on the knee joint (10), obtained through Equation (ll). 

F 2 z is the vertical component of the joint reaction force on the knee joint (10), 
obtained through Equation (10). F 3 z is the vertical component of the joint 
reaction force on the hip joint (8), obtained through Equation (12). 6 c is an 
inclining angle of the thigh (9) obtained by the leg-attitude computing module 

20 (32). t , is a distance from the center of the hip joint (8) to the center of 
gravity Gl of the thigh (9), as shown in Fig. 4, while t 1 3 is a distance from 
the center of the knee joint (10) to the center of gravity Gl of the thigh (9), as 
shown as L c — t 1 in Fig. 4. These values t 1 and t 1 ' are determined 
based on a location of the center of gravity Gl and a size (length) of the thigh 

25 (9), previously obtained. 

Then, a gravity compensation torque computing module (72) computes 
a gravity compensation torques by multiplying values of knee joint moments 
and hip joint moments, obtained by the joint moment estimating module (71), 
by certain factors. The factors are given as constants refereed to as assist 

30 ratios. In human assist systems comprising electric motors or the like for 
supplying knee joints (10) and hip joints (8) with assist torques, to assist 
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operations of the person (l), assist ratios are determine to compensate certain 
ratios of joint moments. Gravity compensation torques obtained as 
mentioned above, are used for control of human assist systems. 

The operations mentioned above are successively carried out 
5 periodically to successively estimate, in real time, ground reaction force acting 
on each (2) of the legs, moments acting on the knee joint (10) and hip joint (8) 
of each (2) of the legs and gravity compensation torques on the knee joint (10) 
and hip joint (8). 

The above-mentioned operations of an embodiment of the present 

10 invention are summarized in Fig. 14. At step S1410 the leg-motion 
determining module (25) determines which leg or legs are in contact with the 
ground. In place of the leg-motion determining module (25), foot switches 
(24) or range sensors may be used for the determination. At step S1420, the 
leg-attitude computing module (32) obtains attitudes of the legs. At step 

15 S1430, the body center of gravity location computing module (41) obtains the 
center of gravity of the body. At step S1440, the center of gravity- acceleration 
computing module (42) obtains an acceleration of the body center of gravity. 
At step S1450, the ground reaction-force estimating module (60) obtains the 
vertical component of a ground reaction force. At step S1460, the module (50) 

20 for estimating a point of application of ground reaction force, obtains a point of 
application of ground reaction force. At step S1470, the joint moment 
estimating module (71) obtains moments acting on the joints. At step S1480, 
gravity compensation torque -computing module (72) obtains torque to be 
applied to the joints. Temporal changes in estimated values of moments 

25 acting on the joints, obtained by the above-mentioned operations of the 
processor (16), are shown with A in Figs. 6 to 13. In Figs. 6 to 13, O shows 
estimated values of moments acting on the joints, obtained through steps in 
which operations are performed using terms of accelerations and terms of 
horizontal forces, with subsequent filtering. In Figs. 6 to 13, □ shows 

30 estimated values of moments acting on the joints, obtained through steps in 
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which operations include terms of accelerations and terms of horizontal forces, 
without subsequent filtering. Fig. 6 shows moments acting on the hip joint 
while the person (l) is going up stairs. Fig. 7 shows moments acting on the 
knee joint while the person (l) is going up stairs. Fig. 8 shows moments 
5 acting on the hip joint while the person (l) is going down stairs. Fig. 9 shows 
moments acting on the knee joint while the person (l) is going down stairs. 
Fig. 10 shows moments acting on the hip joint while the person (l) is sitting in 
a chair. Fig. 11 shows moments acting on the knee joint while the person (l) 
is sitting in a chair. Fig. 12 shows moments acting on the hip joint while the 

10 person (l) is rising from a chair. Fig. 13 shows moments acting on the knee 
joint while the person (l) is rising from a chair. 

In the steps of the present invention for obtaining moments acting on 
the joints, operations are performed without using terms of accelerations and 
terms of horizontal forces. However, referring to Figs. 6 to 13, changes in 

15 estimated values of moments on the joints according to the present invention, 
are similar to those obtained through a method in which operations are 
performed using terms of accelerations and terms of horizontal forces. In 
particular, changes in estimated values during periods while the person (l) is 
sitting in a chair and the person (l) is rising from a chair, are very similar to 

20 those obtained through a method in which operations are performed using 
terms of accelerations and terms of horizontal forces. 

As mentioned above, the embodiment allows real-time and easy 
estimation of ground reaction force acting on each (2) of the legs and moments 
acting on the hip joint (8) and the knee joint (10) of each (2) of the legs, using 

25 relatively small and light sensors and without setting to the legs (2) such 
sensors as hinder the person (l) from walking or make load of motion heavy. 
The relatively small and light sensors include the angular sensors (22, 23) set 
on the hip joints (8) and the knee joints (10) and the gyroscopic sensors (14, 19) 
and accelerometers (15, 20, 21). Further, in the steps for obtaining moments 

30 acting on the joints, operations are performed without using terms of 
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accelerations and terms of horizontal forces. Accordingly, noises caused by 
operations of terms of accelerations can be eliminated and real-time 
operations can be easily achieved in the absence of operations of terms of 
accelerations. In particular, accurate estimation can be carried out while the 
person (l) sitting in and rising from a chair. 

In the embodiment mentioned above, the present invention is applied 
to the person (l). The present invention can be applied also to biped walking 
robots as biped walking systems. In some biped walking robots, the hip and 
the chest are integrated. In such cases a gyroscopic sensor and a 
accelerometer for the horizontal direction are attached to either the hip or the 
chest alone to estimate ground reaction forces and joint moments on the legs 
in a similar way to that of the above-mentioned embodiment. Further, in 
biped waking robots, bending angles of the hip joints and the knee joints can 
be obtained through controlled variables of control devices for joint actuators. 

In the embodiment mentioned above, data detected by the hip vertical 
accelerometer (21) are directly used to determine a phase of motions of the legs 
(2). In place of the detected data, for example, the vertical component of 
acceleration aO of the hip (3) in the absolute coordinate system Cf, obtained by 
the reference -acceleration measuring module (28), can be used. 

As mentioned above, according to the present invention, joint moments 
acting on the legs of walking systems can be obtained and torques to be 
applied to the joints can further be obtained, in control of human assist 
systems and in control of movement of biped walking robots. Such human 
assist systems are intended to assist human operations against gravity 
including going up and down stairs, sitting and standing up, squatting, and 
moving up and down with heavy load. 
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